#ifndef CustomServo_h
#define CustomServo_h
#include <inttypes.h>
#include <avr/pgmspace.h>
class ServoPWMF
{
  private:
    uint8_t t;
    uint8_t f1;
    uint8_t f2;
    uint8_t f3;
    uint8_t f4;
    uint8_t t_angle;
    uint8_t f1_angle;
    uint8_t f2_angle;
    uint8_t f3_angle;
    uint8_t f4_angle;

  public:
    ServoPWMF();
    void writeT(uint8_t);         
    void writeF1(uint8_t);  
    void writeF2(uint8_t);  
    void writeF3(uint8_t);  
    void writeF4(uint8_t);  
    void writeAll( uint8_t ary[]);  
    void setupTimer();
    void printAngles();
    void incrementT(uint8_t maxAngleArg, int increment);
    void incrementF1(uint8_t maxAngleArg, int increment);
    void incrementF2(uint8_t maxAngleArg, int increment);
    void incrementF3(uint8_t maxAngleArg, int increment);
    void incrementF4(uint8_t maxAngleArg, int increment);
};

#endif
